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Dynamic  Inversion:  Application  to  Control  of  Flight  Vehicles 

Rama  K.  Yedavalli+and  Praveen  Shankar* 

The  Ohio  State  University 

Abstract 

State  Dependent  Algebraic  Riccati  Equation  (SDRE)  techniques  are  rapidly  emerging  as 
a  design  method,  which  provides  a  systematic  and  effective  means  of  designing  nonlinear 
controllers,  observers  and  filters.  This  paper  describes  a  new  method  of  integrating  the 
SDRE  technique  with  the  Dynamic  Inversion  control  law  that  is  frequently  used  in  the 
design  of  aircraft  control  systems.  This  paper  also  provides  an  example  by  applying  this 
control  design  technique  to  a  reusable  launch  vehicle. 

Introduction 

There  have  been  a  number  of  design  methodologies  developed  for  control  of  nonlinear 
systems.  The  aircraft  problem  is  one  such  nonlinear  system  to  which  control  design 
techniques  such  as  Dynamic  Inversion  have  been  applied.  Lesser-known  nonlinear  design 
procedures  are  those  that  involve  the  state  dependent  Riccati  equations  (SDRE).  The 
State  Dependent  Riccati  Equation  approach  to  nonlinear  system  stabilization  relies  on 
representing  a  nonlinear  system’s  dynamics  similar  to  linear  dynamics,  but  with  state 
dependent  coefficient  matrices  that  can  be  inserted  into  state  dependent  Riccati  equations 
to  generate  a  feedback  law.  Although  stability  of  the  resulting  closed  loop  system  need 
not  be  guaranteed  a  priori,  simulation  studies  have  shown  that  the  method  can  often  lead 
to  suitable  control  laws. 

Over  the  past  several  years  various  SDRE  design  methodologies  have  been  successfully 
applied  to  aerospace  problems.  SDRE  based  design  procedures  have  been  used  in 
advanced  guidance  law  development  [1,2]  and  in  an  output  feedback  autopilot  design  [3]. 
Additionally,  SDRE  design  methods  have  been  used  in  nonlinear  filter  development  [4]. 

In  [5],  Ehrler  and  Vadali  investigated  the  nonlinear  regulator  problem  and  showed  that 
solving  an  algebraic  Riccati  as  it  evolved  oyer  time  provided  one  means  of  obtaining  a 
sub  optimal  solution  of  the  infinite  horizon  problem.  In  essence  the  State  Dependent 
Riccati  Equation  was  treated  as  being  time  dependent  and  its  state  dependency  was  not 
explicitly  acknowledged,  addressed  or  analyzed.  In  [6],  SDRE  nonlinear  regulation, 
SDRE  nonlinear  H«>,  and  SDRE  nonlinear  H2  design  methodologies  were  defined  and  the 
optimality,  sub  optimality  and  stability  properties  of  SDRE  nonlinear  regulation  was 
investigated. 
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Overview 


SDRE  stabilization  refers  to  the  use  of  State  Dependent  Riccati  Equations  to  construct 
nonlinear  feedback  control  laws  for  nonlinear  systems.  The  main  idea  is  to  represent  the 
nonlinear  system 

x=f(x)+B(x)u 

in  die  form 

x=A(x)jc+B(x)u 

and  to  use  the  feedback 

u=-R~'(x)Bt(x)P(x)x 

where  P(x)  is  obtained  from  the  SDRE 

P(x)A(x)  +  Ar(x)P(x)  +  Q(x)-P(x)B(x)R~1(x)Bt(x)P(x)= 0 

and  Q(.)  and  R(.)  are  design  parameters  that  satisfy  the  point  wise  definiteness  condition 
Q(x)  >  0  R(x)  >  0 

The  resulting  closed  loop  dynamics  have  a  linear-like  structure  given  by 

x=Aa(x)jc  where 
ACL(x)=A(x)-R-1(x)B(x)Br(x)P(x) 

Simulation  studies  have  shown  that  the  dynamics  matrix  satisfies  the  Lyapunov  Criterion 
for  stability  given  by 

P(x)Acl (x) + A&  (x)P(x)<- Qpj  where 
Qp<>0 


‘I 


It  ■  !•:. 
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Equations  of  Motion  of  Aircraft 

^=P+£)sin^tan0  +  i?cos^tan0 

6=Qcos<j>-Rsm<p 

iff = Q  sin  <f>  sec  6  +  R  cos  </>  sec0 

P  =  cxRQ + c2PQ + C3I +caN 
Q=c5PR-c6(P2 -R2)+c7M 
R = csPQ  -  c2RQ + c4L  +  c9N 

U=RV-QW+^L-gsm0 

m 

F 

V=-RU  +  PW +— +  gcos0sin^ 
m 

F 

W =QU  -  PV + —  +  g  cos  6  cos<j> 
m 

where 

cx=[Vy-Jz)J,-JlVr 

ci-v^+J'Vjr 

c3=jz/r 

c4=^/r 

c5=(J,-JJ/Jy 

=  J xz  /  J y 

c7=UJy 

c8=[(^-W+ 4]/r 

c9=Jxir 

where 


State  Dependent  Linear  State  Space  System 
Example  1 

State  :  x=[P  Q  /?] 
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Example  2 

State  :  x=[P  Q  R  <p  0  y] 


c2x2 

0 

0 

0 

O' 

V 

C3 

0 

c4" 

~C6Xl 

0 

C5x,  +C6x 3 

0 

0 

0 

x2 

0 

C 7 

0 

0 

C8*l 

-c2x2 

0 

0 

0 

x2 

C4 

0 

C9 

r  l 

1 

sinxjtanxj 

cosx5  tanx5 

0 

0 

0 

X4 

+ 

0 

0 

7 
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Example  3 

State  :  x=\u  V  W  P  Q  R  sin#  cos 6 sin (j>  cos#cos<J>] 
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Schematic  Representation  of  the  Method 


Combined  SDRE  and  Dynamic  Inversion  Control  Law 
Stability  of  Nominal  System  for  Full  State  Feedback 
x=A(x)x+Bu 

Riccati  Based  Control  Law 
u=  -R~iBTP(x)x 

Dynamic  Inversion  Control  Law 

u  =  B'1(xda -  A(x)x 
W.K.T  B'x  =  (BTB)~' 

Let 

Xfe  =  Aies  (*)* 

Then 

u  =  -(BTBy'BT(A(x)-Ada(x))x 

Comparing  Equations  (1)  &  (2)  ;  j  .  in-  ■> 

R  =  BtB 

P(x)  =  A(x)-Ades(x) 

The  SDARE  becomes 

P(x)A(x)+Ar(x)P(x)+Q-P(x)P(xj= 0 


+\  Aircraft 
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Solving  the  above  equation  for  P(x),  we  can  calculate 

'  4da(x)  =  A(x)-P(x) 

Stability  of  Nominal  System  for  Output  Feedback 

x=A(x)x+Bu 
©  =Cx 

<i>=Cx=CA(x)x+CBu 

Let  <i>de,=Ate(x)x 

Riccati  Based  Control  Law 
u  =-R~]BtP(x)x 

Dynamic  Inversion  Control  Law 
u=(CB)+((6da-CA(x)x) 

u=-(CB)+(CA(x)-Ada(x))x 

«=- {(CB)r(CB)}-'  (CB)T(CA(x)  -  Ades  (x))x 

u=- C BtCtCB )-'  BtCt  ( CA(x )  -  A,.  (x))x 

Comparing  Equations  (3)  &  (4) 

R=BtCtCB 

P(x)=Cr(CA(x)-Ada(x)) 

The  SDARE  becomes 

P(x)A(x)+AT(x)P(x)+Q-P(x)B(BTCTCBy'BTP(x)= 0 

Solving  the  above  equation  for  P(x),  we  can  calculate  Abusing  the  equation 
P(x)=Cr(CA(x)-Ades(x)) 

Closed  Loop  System 

*  =  W  +  B(CBY  (4*.  (x)  -  A(x))]x  =  Ac  (x)x 


Verification  of  Stability 

^^pr,t,Ve  d.efifite  T"’1- Which  is  chosen  “  pi  “  P(*°)  is  the  solution  to 

the  SDARE  at  the  initial  condition  {x©} . 
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Full  State  Feedback 

P(x0)A(x0) + AT{xa)P(xa)  +  Q-P(xQ)P(x(j)=Q 
Output  Feedback 

P(xa)A(x0)+AT(X')PM+Q-PMB(BICTCBr'BrP(xt)=0 

The  Closed  Loop  System  is  locally  asymptotically  stable  if 
PLAc(x)+A*(x)PL<  0 

Application  of  Combined  SDRE  and  Dynamic  Inversion  Control  Law  to  Aircraft 

State  :  x=[U  V  W  P  Q  R  sin#  cos#  sin  ^  cos#cos<()] 

0  x6  -x5  0  0  0 

-  x6  0  xA  0  0  0 

xs  -x4  0  0  0  0 

0  0  0  ^2XS  ^lX6  ® 

0  0  0  -C6x4  0  C5x4+c6x6 

0  0  0  0  CgJt,  ~c2xs 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 

where 

0  x6  -x5  0  0  0  —g 

-x6  0  x4  0  0  0  0 

xs  -x4  0  0  0  0  0 

0  0  0  c2x5  cxx6  0  0 

0  0  0  ~c6x4  0  c5x4+c6x6  0 

0  0  0  0  c8x,  -cix$  °' 

0  0  0  0  0  0  0  * 

0  0  0  0  0  0  x6 

0  0  0  0  0  0  -xs 

The  above  state  space  system  is  not  completely  controllable.  However  if  we  separate  the 
A(x)  matrix  into  Ai(x)  and  A2(x)  given  by 


0 

0 

0 

0 

C7 

0 

0 

0 

0 
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Mx)= 


^2^5  ^1  ^6 

-c6x4  0 


£5X4  ^6^6 


and  A2(x)  = 


0  “*«  * s 


then  the  pair  (Ai(x),Bi)  are  completely  controllable. 


Mx)=\ 


c2x5  ctx6 


0  c5xA  +  c6x6 


-c2x5 


Therefore  we  can  design  a  control  law  given  by 
u  =  Bi~'(xda 

where  *,=[*,  x2  x3  x4  xs  x6] 


u  =  Bt~ 

(Xjc  -Ai(x)xt 

where 

Xl  —  [aTj  x2  Ij 

and 

u  =  [Fx  Fy  F, 

W.K.T 

and  Bl  = 


Mm  0  0  0  0  0 

0  Mm  0  000 

0  0  Mm  0  0  0 

0  0  0  c3  0  c4 

0  0  0  0  c7  0 

0  0  0  cd  0  c„ 


.  Let 

*l<fa  =  AUes 

Then 

u  =  -(BiTBiyiBlT(Al  (x)  -  Alia  (x))xt 
Aides(x)  is  calculated  from  the  equation 

Ades(x)  =  A(x)-P(x) 

where  P(x)  is  the  solution  to  the  Riccati  Equation 

p(x)A  (x)  +  A*(x)P(x)  +  Q-  P(x)Bl  (x)R~i  (x)B*  (x)P(x) = 0 

However  we  know  that 
R  =  B*BX 
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Therefore  the  State  Dependent  Algebraic  Riccati  Equation  reduces  to 
P(x)Al  ( x )  +  Atr  (x)P(x)  +  Q-  P(x)P(x) =0 
The  closed  loop  system  is  given  by 
xx  =  A,  (x)x + By  (Aldes  (x)  -  Ay  (x))xt  ] 

Therefore,  we  have 
x,=Acl(x)xy 

where  Ac,  (x) = Ax  (x)  +  Bx  [I?,-1  (Aldes(x)  -  At  (x))] 

Verification  of  Closed  Loop  System  Stability 
In  the  previous  section  we  separated  A(x)  into 

0  x6  -x5  0  0  0 

-x6  0  x4  0  0  0 

x5  -  x4  0  0  0  0 

0  0  0  c2x5  CyX6  0 

0  0  0  ~c6x4  0  c5x4+c6x6 

0  0  0  0  cgXj  -c2xs 

The  matrix  A2(x)  is  neutrally  stable  if  we  calculate  it’s  eigenvalues  by  freezing  the  states 
at  each  time  instant.  However  we  are  more  concerned  about  the  stability  of  matrix  Ai(x) 
under  die  control  ‘u’  that  we  previously  discussed.  The  closed  loop  system  under  control 
‘u’  is  given  by  Ad(x). 

Let  PLbe  a  positive  definite  matrix,  which  is  chosen  as  PL  =  P(xi0).  P(xi0)  is  the  solution 
to  the  SDARE  at  the  initial  condition  {xi0} . 

P(x10)4(*,0)  +  ■^(XioV’teo)  +  Q-  P(xlo)P(xlo)=0 

The  closed  loop  system  is  locally  asymptotically  stable  if 

PLAcl(X)  +  Ah(X)PL  <° 


and  A2(x)  = 


0  -x. 


0 


L~X5 


0 


Results 

Initial  Condition  1 
Uo  =  517.5 
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Vo  =  0 
Wo  =  27.5 
Po  =  0 
Qo  =  0 
Ro  =  0 


? 
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Results 

Initial  Condition  2 
Uo  =  517.5 
Vo  =  0 
Wo  =  27.5 
Po  =  0.5 
Qo  =  0.5 
Ro  =  0.5 


(SisfffieHiJicd^Phi;  «6ifTR«*a)srn(Ph^  slnfTlieta) 
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tfffif  f-x,0yjF* 


%  4  6  f  . U  12 


time  (secj 
UtiH 


2  4  6  8  10  12 


I  *  f  8  fjO:  12: 


t  4  f  S  IP  12: 

lime  (sec): 


15 


Conclusions 


In  this  paper  a  new  control  law  was  developed  that  is  a  combination  of  the  existing  State 

Dependent  Riccati  Equation  techniques  and  the  Dynamic  Inversion  control  law.  This 

control  system  design  was  then  applied  to  the  aircraft  dynamics  and  the  resulting  closed 

loop  system  was  shown  to  be  stable  even  under  change  in  the  initial  conditions. 
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